Atlas Gen2 Slam And Path Planning.